#include <reg52.h>
#include "Motordriver.h"
#include "CarPose.h"
#include "Timer.h"
#include "Track.h"


sbit D1=P2^6;
sbit D2=P2^5;
sbit D3=P2^4;
sbit D4=P2^3;
sbit D5=P1^0;

void path()
{ 
	if(D1==0&&D2==0&&D3==0&&D4==0)
	   {pwmL=0;pwmR=0;CarGo();}
	if(D1==0&&D2==1&&D3==1&&D4==0)
	   {pwmL=15;pwmR=15;CarGo();}
	if(D1==0&&D2==0&&D3==1&&D4==0)
	   {pwmL=20;pwmR=0;CarGo();}
	if(D1==0&&D2==1&&D3==0&&D4==0)
	   {pwmL=0;pwmR=20;CarGo();}
	if(D1==0&&D2==0&&D3==1&&D4==1)
		 {pwmL=90;pwmR=0;CarGo();}
	if(D1==1&&D2==1&&D3==0&&D4==0)
			{pwmL=0;pwmR=90;CarGo();}
	if(D1==1&&D2==0&&D3==0&&D4==1)
		{pwmL=30;pwmR=0;CarGo();}
	if(D1==1&&D2==1&&D3==1&&D4==1)
		{pwmL=10;pwmR=10;CarGo();}
		if(D5==1)
		{pwmL=10;pwmR=10;CarBack();}
}